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INTRODUCTION 


The extended Kalman filter (EKF) is the basis for many applications of filtering theory to 
real-time problems where estimates of the state of a dynamical system are to be computed based 
upon some set of observations. The form of the EKF may vary somewhat from one application 
to another, but the fundamental principles are typically unchanged among these various 
applications. As is the case in many filtering applications, models of the dynamical system 
(differential equations describing the state variables) and models of the relationship between the 
observations and the state variables are created. These models typically employ a set of 
constants whose values are established my means of theory or experimental procedure. Since the 
estimates of the state are formed assuming that the models are perfect, any modeling errors will 
affect the accuracy of the computed estimates. Note that the modeling errors may be errors of 
commission (errors in terms included in the model) or omission (errors in terms excluded from 
the model). Consequently, it becomes imperative when evaluating the performance of real-time 
filters to evaluate the effect of modeling errors on the estimates of the state. 

EKF WITH CONSIDER COVARIANCE 

Assume that the EKF is to be applied to a system described by the (possibly) nonlinear 
differential equations 


X = F(t,X / C) 0) 

using the (possibly nonlinear) observation-state equation 

Y = G(t,X,C) + e ( 2 ) 

where X is the state whose values are to be estimated and C is the set of consider parameters. 
Note that C encompasses parameters in the equations of motion and the observation equation 
although it will be rare that any single parameter will be in both sets of equations. Note also that 
the values of C are not perfectly know, i.e., the true values of C are not available; only some 
nominal values of C (which will be referred to as C{\j) and the uncertainties are known. The 
variable £ represents the measurement error which is assumed to white noise and have the 
following statistics 

E[ei] = 0 ; E[e [ eJ] = R i Q) 

To apply the EKF, this system is converted into a linear system by expanding Eq.s (1) 
and (2) about a reference trajectory X N (t) that is known with the corresponding obsen/ations 
which are described by 


Xn = F(t,X N/ C N ) 


Yn = G^X^Cn) 
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The resulting system and observation equations are given by 
x = A(t,XN,C[\[) x + B(t,XN,CN) c 
y = H x (t,X N ,C N ) x + Hc(t,X N ,CN)c +e 

where x = X-X N , c = C-C N , A = || , B = || , H x 
the solution for x(t) in Eq. (4) can be written as 

x(t) = 0(t,tk) x(tk) + @(t,tk) c 

where <X> and © satisfy 

<J>(t,t 0 ) = A(t,XN,C]\j) <D(t,to) 0(to/to) = I 

©(t,t 0 ) = A(t,X N/ C N ) 0(t,to) + B(t,X N ,C N ) ; 0(to,t o ) = 0 

The filter state vector is x(t), the estimate of x(t) is x(t), and the estimate of X(t) is recovered 
using X(t) = Xn( 0 + x(t). 

To initialize the filter, assume that initial values for Xk-i = x(tk-i) and 
Pk-l = E [(Xk- i-Xk-i)(xk-i-Xk-i) T ] as well as X^ftk-i) are given. This information is to be 
propagated to tk and combined with the observation yk = y(tk) to form the estimate x(tk). Once 

the values for <X>(tk,tk-i) and ©(tk/tk-i) are computed, the propagation of the filter state vector is 
carried out using Eq. (6) in the form 

Xk = ^(tk/tk-l) Xk-i + ®(tk/tk-i) C (7) 

Similarly, the true state vector would be propagated using 

Xk = OftkA-i) x k-i (8) 

since for the true state vector there is no error nor uncertainty in the consider parameters. Using 
Eq.s (7) and (8), the covariance matrix corresponding to Xk is written as 

P k = E [(x k -Xk)(xk-Xk) T ] 

= ^k-iE [(xk-i-Xk-i) (xk-i-Xk-i) T ] Ok,k-i + <bk,k-l E [(xk-i-Xk-i) c T ] ©k^k-i 
+ ©k,k-l E [c (Xk- 1 -Xk -1 ) T ] d>k,k-l + ©k,k-l E [c C T ] ©k,k-l 


(4) 

(5) 

^ , and He = . Note that 

dX dC 


( 6 ) 
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For now let, Wk-i = E [(xk-i-Xk-i) c T ] which will be discussed in more detail in the following 
sections. The expected value expression in the last term represents the uncertainties in the 
consider parameters which is assumed known and can be represented as 

E[ccT] = n 

Thus, for now, the propagated covariance matrix becomes 

Pk = ^kk-lPk-l^kk-l + ^Kk-lWk-iOk'k-l 

+ @k,k-lWic-i<I>k T k-l + 0k,k-in©Jk-l (9) 

Note that the first term in this equation represents the propagate covariance matrix if there were 
no consider parameter effects and the remaining three terms are the contributions of the consider 
terms. 


Once the filter state vector estimate and associated covariance matrix have been 
propagated to tk, it can be treated as an observation and combined with yk to write 


yk-HckC 



H xk 

Xk + 




I 


.Ok. 


where E [rj k ] = 0 , E [% r|£] = P k , and E [e k T]0 = 0. The solution for x k which satisfies 

these equations in a least squares or minimum variance sense is 

x k = ( Hlk Rk 1 H xk + Pk 1 K 1 (Hj k Rk 1 (Yk - Hck c) + Pk 1 x k ) 00) 

For convenience, let 

M k = (HlkRk Hxk+Pk 1 )' 1 00 

which would be the state vector covariance if there were no consider parameters. 

The covariance matrix associated with x k is formally defined by 
P k = E [(x k -x k ) (xk-x k ) T ] 

From Eq.s (10) and (11), 

Xk-Xk = Xk - Mk H^k Rk 1 (yk - H c k c) - MkPk ! x k (12a) 
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Using Eq. (5) to express the observation in terms of the true state and true consider parameters 
(c=0) to write 

yk =H xk x k + e k 

then Eq. (12a) can be written as 

x k -x k =[l-M k Hl k R k 1 H xk ]x k - MkHjkRk 1 ^ 

- M k H x k R k H c k c - M k P k x k (12b) 

Note that from Eq. (1 1), it can be shown that 

[ I - M k Hj k Rk 1 H xk ] = M k P k ! (13) 

Consequently, Eq. (12b) can now be written as 

x k ” x k = M k P k ( x k - x k ) - M k H xk R k £ k - M k H xk R k H ck c (12c) 

The covariance matrix for x k can now be expressed as 

Pk = M k P k ! Ml - M k P k : W k Hc T k R k : H x k Ml 

- M k H J k Rk 1 H c k P k T M k + M k H x \ R k H x k M k 

+ M k Hj k Rk 1 He k n Hj k Rk T H x k M l (14) 

where it has been assumed that 

E [(xk-xk) el] = 0 E[ccT] = n E[e k el] = R k 

H [c el] = 0 E[(x k -x k )c T ] = W k 

Note that the first and fourth terms of Eq. (14) can be combined to write 

M k (Pk 1 + Hj k Rk H x k ) Ml = M k 

Also note that from Eq. (10), the sensitivity matrix can be defined as 

S k = - M k Hjk R k He k (15) 

Using this notation, the covariance matrix for can be written in the form 
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(16) 


P k = Mk + Mk Pk 1 Wk sj + Sk Wk Pk T Mk + Sk n Sk T 

As was the case with the expression for Pk, the first term in Eq. (16) represents the covariance 
matrix if there were no consider parameters and the remaining three terms represent the 
contribution of the consider parameters. 

The only remaining issues to resolve are the expressions for Wk from Eq. (9) and Wk 
from Eq. (16) which are defined as 

Wk = E [(xk-xk) c T ] and Wk = E [(xk-xk) c 7 ] 

Using Eq. (12c), Wk can be written as 

Wk = Mk P^ Wk - Mk HjJk Pic 1 H c k n 

= MkPk 1 Wk + s k n ( 1? ) 


Using Eq.s (7) and (8), W k can be written as 

Wk =o k ,k-iW k -i + ©k>in ( 18 ) 

Eq s (17) and (18) provide the necessary equations to propagate and update W along with the 
covariance matrices M k and P k . To initialize this part of the filter, it is assumed that 

Wo = E [(x 0 -Xo) c t ] = 0 

i.e., the initial estimate of the state vector is not correlated to the uncertainties in the consider 
parameters. Note that by using Eq. (17), Eq. (16) can also be written as 

p k = M k +W k Sk T + s k w k T - s k nSk ( 19 ) 

Finally, note that Eq. (7) can be used to define the propagated sensitivity matrix as 


Sk = = ^k,k-l Sk-i + ®k,k-i 

dc 


( 20 ) 


CONCLUSION 

The consider covariance EKF can be used to evaluate the effect of uncertainties of 
dynamic and measurement modeling errors on the estimate of the state by adjustments made to 
the state covariance matrix. While the consider covariance EKF does not predict the actual 
errors since the actual model errors are assumed unknown, it does provide a means of identifying 
critical elements of the dynamic and observation models for real-time filtering applications. 
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